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(57) Abstract: The present invention therefore relates to a method and the use of a method for position determination of an automatic 
apparatus on wheels (1), such as a robotic vaccum cleaner. At least one wheel on the apparatus comprises at least one wheel sensor 
(not shown) that recognizes the rotation of said wheel. The apparatus also comprises at least one room sensor (2, 3a-3e. 4a-4d) 
detecting objects in the space surrounding the apparatus. The position determination is accomplished at least by using one wheel 
O sensor and estimate the substantial horizontal extension direction (14) of substantially vertical planes (13) on the objects (10 -12), 
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METHOD FOR POSITION DETERMINATION OF AN AUTOMATIC 
APPARATUS ON WHEELS 

TECHNICAL AREA 

5 The present invention relates to a method and the use of a method for position 
determination of an automatic apparatus on wheels, such as a robotic vacuum cleaner. At 
least one wheel on the apparatus comprises at least one wheel sensor that recognizes the 
rotation of said wheel. The apparatus also comprises at least one room sensor detecting 
objects in the space surrounding the apparatus. 

10 

BACKGROUND 

Automatic apparatus on wheels, so called robots, are products that during the recent years 
have increased in importance and interest. Earlier they have been used in industries, 
professionally, mainly for manufacture tasks. Some of these robots have had features in 
15 order to been able to navigate and move in the environment and detect objects in the 
surrounding area. During the recent years consumer aspects has reached into the robotic 
area and the features such as for navigation is of interest for the consumers. 

One way of achieving navigation possibilities is to place magnetic strips in the floor, 
20 which strips the robot follows. The use of strips enables for the user to predetermine the 
navigation route for the robot. The area around the route can thereby be marked of for 
people. A magnetic strip following robot may also have the capacity of detecting if it 
collides with anything, such as an obstacle or the object that it is intended to work with. In 
order to sense such collisions sensors, which sense physical contact could be used. 

25 

Instead of magnetic strips, the robot can use a navigation system that relies on detecting 
sensors, such as IR (infrared) or Ultrasonic sensors. These sensors can detect objects in its 
surroundings by transmitting and receiving reflected signals. By using these types of 
sensors the direction and distance to the sensors can be estimated. In order to manage that, 
30 the sensors have to be mounted on the robot and controlled in a proper way! Such a sensor 
system is disclosed in the European Patent EP0835459. 
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wheel sensor detecting the rotation on each wheel. These sensors sense the wheel rotation 
and are calibrated regularly in order to take into consideration the distance between the 
wheels and the wheel dimensions. Wall following is a method that use this kind of wheel 
sensing system. In this method, the robot starts its operation by following the walls 
5 around the room. When this is completed, the robot estimates the size of the room, at least 
based on information from the wheel sensors, and starts navigating inside the room at 
least using information from said wheel sensors. 

One problem with this wail following using wheel sensors, is that wheel often slips on the 
10 floor. These slips often occur when the wheels are worn out and/or the friction against the 
wall is bad. Another typical cause is cords lying on the floor. This means that if the robot 
uses wall following it very soon will get problems navigating. In order to solve this 
problem, a method SLAM is developed. SLAM calculates the robot position based on the 
relation in position between the robot and an object In order to do that a sensor system 
15 with Ultrasonic or IR can be used. SLAM builds a map of the room inside which the robot 
navigates. By using a specific algorithm the position of the robot is estimated. 

If SLAM is used together with a sensor system that only detects objects in its presence, 
the method gets difficulties in its estimations. If there are no detectable objects near the 
20 robot, this will cause SLAM to fail or work with higher uncertainty because SLAM has 
too few objects to work with. A way is solving this problem is to improve the capacity of 
the sensor system. However, all such improvements cost money, which results in more 
expensive products for the consumer. 

25 The object of the present invention is therefore to achieve a navigation method for a 
regular robot, which method should be quite reliable and easy to use without the need of 
expensive components. The method intends to be used in robots, such as robotic vacuum 
cleaners, in order to improve its operation capacity. 

30 SUMMARY OF THE INVENTION 

The present invention therefore relates to a method and the use of a method for position 
determination of an automatic apparatus on wheels, such as a robotic vacuum cleaner. At 
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objects in the space surrounding the apparatus. The position determination is 
accomplished at least by using one wheel sensor and estimate the substantial, horizontal 
extension direction of substantially vertical planes on the objects, which planes are 
defined by the apparatus, whereby the substantial, actual position of the apparatus is 
5 determined using at least one predetermined assumption on the relationship between the 
extension direction of different planes. 

The method is using wheel sensors for position determination and together with that uses 
predetermined assumptions on characteristics for surrounding planes defined by the 
10 apparatus, the information and equipment needed is cheaper. 

DRAWINGS 

Fig. 1 shows a perspective view of a robot at which the method of the present invention is 
applied. 

15 

Fig. 2 shows a side view of the robot according to fig. 1 . 

Fig. 3 shows a front view of the robot according to fig. 1 . 

20 Fig. 4 shows a graph of how the sensor system of the robot according to fig. 1 detects is 
surroundings. 

Fig. 5 shows a simplified flow chart of the method according to the present invention. 

25 Fig. 6 shows a simplified view of how the method according to the present invention 
estimates its current position. 

Fig. 7 shows how the estimation according to fig. 6 is partly made. 

30 AN ILLUSTRATIVE EMBODIMENT 

Fig. 1 - 3 shows an illustrative example of a robot together with which the method 
according to the present invention can be used. The features and navigation system of the 
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Fig. 1 - 3 shows an automatic vacuum cleaner robot. The robot shape is circular and it is 
supported by two driving wheels 1 together with a front supporting wheel (not shown). 
The driving wheels are made in order to achieve the best possible friction against the 
floor. The two driving wheels are controlled in order to move the robot in any direction 
5 over the floor on which it operates. Each driving wheel therefore is connected to an 
electric motor, eventually via a gear, which motor is controlled by a control unit, whereby 
the unit brings the robot into movement. The robot also comprises a brush roller (not 
shown) as a part of the floor-cleaning feature. This cleaning feature will not be described 
any further, since its function is not important for the scope of the present invention. 

10 

The robot has wheel sensors (not shown) that detect the wheel rotation on each of the two 
driving wheels 1. The dimension of each driving wheel is stored in connection to the 
control unit. Moreover, a calibration method further described in the published Swedish 
patent application 0100925-7 is used. The method calculates the navigation route of the 
15 robot talcing into consideration the variations in distance between the two driving wheels. 
This variation is assumed to depend on if and how much the robot turns. By dividing the 
robot movement into different modes related to different values of wheel distances, each 
mode could be properly used in order to estimate the movement of the robot in relation to 
the floor. 

20 

In order for the robot to detect objects in its surroundings it is equipped with a sensor 
system. Thereby, the robot can detect the objects, perform estimating calculations of there 
position in relation to the robot, and thereafter control the movement of the robot as 
wished. One controlled movement could be to bring the robot into a slower motion as it 
25 approaches the object. Another option is to enable a more effective navigation route. Such 
an option is disclosed in the published Swedish Patent application 0100924-0. When 
navigating the robot divides the floor surface into cells, each cell being connected with a 
value that is re-evaluated as the robot moves. The navigation route is decided depending 
on which value the cells near the robot have. 

30 

The visible outer parts of the sensor system of the robot are shown in fig. 1-3. The 
system uses ultrasonic signals in order to detect obstacles and objects in its surroundings. 



WO 03/062937 PCT/SE03/00098 



and 4a - 4d are placed along the front side and receives the transmitted signals reflected 
by an object or obstacle. In fig. 4 it is shown how the system detects one point in the 
object. In fig. 4 "mik 1 - 5" for example corresponds to the microphones 3a - 3e. 

5 Solid-drawn lines in fig. 4 relates to the reflected signals detected by the microphones 3a 
- 3e. The system detects one point at a time. Knowing about how the transmitter 2 and the 
microphones are oriented and the characteristics of the ultrasonic signal the robot can 
estimate the distance and direction to a detected point on an object. In the published 
Swedish Patent SE502834 such a sensor system is described more in detail. In fig. 1 in 

10 this application, a free moving and hanging front part 6 which the robot uses in order to 
detect a direct collision with an obstacle or object is shown. The front part moves when 
getting in contact with an object and affects micro switches or other motion detectors 
behind the front part. An over part 7 under which a dust collecting container is mounted is 
also shown in the figure. 

15 

In order to enable an effective navigation the robot uses the wall following behaviour, as 
described earlier in this document. Using this behaviour, the robot first starts seeking up a 
wall, see fig. 6. Thereafter, the robot follows the walls that surround the room all the way 
around until it has reached back to its original wall following position. The wheel sensors 

20 detect the motion and calculate the position of the robot. Based on the wall following, the 
robot creates a map of the room. The sensor system is uses in order to control that a wall 
is followed. In fig. 6 the positions of the robot, estimated by the wheel sensors on the 
robot, are shown as a dotted line 8. The actual position of the robot is shown as the solid- 
drawn line 9. The outer frame 10 of the figure corresponds to the surrounding walls and 

25 the two black areas 11,12 corresponds to obstacles in the room area. Since the sensor 
system detects the walls and obstacles it is possible to achieve a working wall following 
behaviour. 



The method according to the present invention will know be described more thoroughly. 
30 The wall following behaviour shown in fig. 6 constitutes the frame of the method 
according to the present invention. A problem with the wall following behaviour is that 
the position of the robot is estimated based on the wheel sensors. Since the movement of 
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movement, shown as the solid-drawn line 9, is created since the robot in reality is 
following the walls. Each time a driving wheel 1 slips on the floor, or in other ways loose 
direct contact with the floor, an error is added to the estimated position, which causes the 
total error of the estimation to increase as the robot movement proceeds. 

5 

In order to achieve improved position estimation for the robot the invention method uses 
the wall following behaviour. Also, the method according to the present invention 
assumes a relation in horizontal extension direction between the walls or between walls 
and other larger objects in the area (room) in which the robot operates. The assumption is 

10 based on the fact that walls are normally perpendicular to each other. Other angles, such 
as 30° (DEG), 45° or 60°, are common in modem rooms and can also be taken into the 
assumption. In this illustrative embodiment perpendicular and parallel walls are of most 
interest, but the present invention shall be read taking the other wall angle relations in 
consideration. As for larger objects, the assumption is that these are normally placed 

15 perpendicular or in parallel with a wall. They may also be placed in 30°, 45° or 60° 
relations to a wall. 



Taking these assumptions into consideration the position of the robot, estimated 8 based 
on information from the wheel sensors, is to be corrected into the correct position 9. The 

20 method compares the estimated direction when the robot follows a first wall or larger 
object with the estimated direction when the robot follows a second wall. The errors 
(skids etc.) cause these estimated directions to differ from each other with more or less 
than 90°, 180°, 270°, 360° (for the perpendicular or parallel objects or walls). Knowing 
that there is a difference between the estimated value and the assumption value gives the 

25 robot information, which enables it to correct the estimated position. Referring to fig. 6, 
the estimated route shown as the dotted line 8 will be corrected into the actual route, 
shown as solid-drawn line 9. Later, a new correction can be accomplished if the estimated 
position is shown to again differ. As an alternative, a wall following using the method of 
the preferred embodiment is regularly performed. 

30 

In order to avoid that the robot mixes up the walls and larger objects with smaller objects 
that normally are more freely positioned in the area (room), certain threshold values are 
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Below, an algorithm corresponding to the method according to the present invention, is 
shown, see also the flow chart in fig. 5. The algorithm contains the following steps: 

5 if FollowingStraightWall 
k=k+l 

if endWallEncountered 
Extract line parameter / 
if {l>minLength) 
10 Extract line parameters (p, £) 

if firstLine 
Set Ref Angle = s 

else if | 8 - Ref Angle | <angleTh 
Backtrace the robot pose from the 
1 5 starting point of the wall compensating 

for the angular error 

k=0 

FollowingStraightWall relates to the earlier mentioned wall following behaviour. Wall 
20 following is accomplished by the sensor system, in which the transmitter 2 and the 
microphones 3a - 3e, 4a - 4d detects and makes sure that the robot can follow a wall or 
any other plane detected by the sensor system. A detected plane could relate to a solid 
furniture wall side or a virtual wall sides defined and created by the sensor system, which 
virtual wall for example extends between the legs of a large sofa. The method according 
25 to the invention is not intended to be limited to which kind of walls the robot can see and 
define, but to the fact that the robot starts a wall following procedure following of any 
wall or plane. Even if the method primary is intended for the following of solid walls of 
any kind, which means that the robot cannot physically pass 'through" the wall, any wall 
or furniture side followed will from now on be defined as a plane defined by the robot, 
30 whether or not it is a solid wall or a virtual wall. As the robot moves in parallel with the 
plane it continuously detects or for virtual walls assumes points on the plane, and if the 
distance remains substantially constant the FollowingStraightWall is set. The distance 
must also remain within a certain threshold value, for example 5 centimetres. The 
threshold value will cause the robot to detect if a wall is ended. For virtual walls this 
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differently, not described here. The idea with this distance idea is to investigate if a solid 
wall is followed properly. 

If the sensor system from the wheel sensors detect that the moving direction of the robot 
5 after FollowingStraightWall is set diverges, this diverge must be kept within a threshold 
value of for example 3° (DEG). this value is set in order to detect if a plane is ended or if 
the Wall following has start oscillating. The threshold angle relates to the difference in the 
moving direction on two different moments after one another. Further, a second threshold 
value of for example 5° (DEG) is set that relates to the difference in moving direction 

10 between , the direction registered at the moment of FollowingStraightWall and the 
direction registered at the last moment when a plane ends or the robot stops following a 
wall, at endWallEncountered. This second threshold value is set in order to detect if the 
plane followed was straight or curved. Here also, a virtual wall normally will be followed 
without angle divergences, which means that such a control for virtual walls works 

15 differently. 

When one of these threshold values is exceeded endWallEncountered is set. Thereafter 
the moving distance between FollowingStraightWall and endWallEncountered is 
registered. This distance corresponds to the length / of the plane, which corresponds to the 

20 wall 10 or larger object 11,12 along which the robot has moved. If / is larger or equal to 
minLength, for example set to 80 centimetres, the essential extension direction e of the 
defined plane followed and the extension length p of the same plane is calculated with a 
Hugh Transform (not shown or described here) and stored. Both values are calculated 
based on the information registered by the wheel sensors. Considering virtual walls, 

25 endWallEncountered will be set based on other control aspects as mentioned earlier. How 
this is done will not be described any further in this application. The important thing is 
that endWallEncountered is set also for virtual walls when the wall following of those 
fulfil certain demands, and that the distance demands controlled after endWallencountered 
will be evaluated also for the virtual walls. 

30 

Further, according to the method, if the robot establishes that the plane values are the first 
stored after a certain moment, s is set as Ref Angle. This means a moment when the robot 
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plane values are not the first stored after that moment the angle s will be compared with 
RefAngle. During this comparison the difference will be compensated for the assumption 
angles 90°, 180°, 270°, 360° mentioned above. This means that if the difference is 93°, 
90° will be subtracted and a result difference value of +/- 3° will come out, defined as 
5 Rdiff If it is shown, during this comparing, that Rdiff has a value that is not zero it also 
needs to stay within a threshold value angleTh. 

The threshold value angleTh is not definite but continuously recalculated based on the 
uncertainty registered during earlier adjustments done by the method according to the 
10 invention. Its maximum value is 25° in case the assumption is that only the angle relation 
between two defined planes are 90°, 180°, 270° or 360°. The compensated Rdiff can be 
defined as: 

Rdiff =min [|*- Ref Angle \,\e- (Ref Angle + 90°)| , 
15 \e- (RefAngle + 180°)| , \s - (RefAngle + 270°)|] 

In case other assumption angles are allowed (for example 30°, 45°, 60°) angleTh should 
be lower in order for the method to work satisfying. Rdiff will thereby be compensated 
based also on these assumption angles. 

20 

The compensated Rdiff is finally used in order to adjust the position estimated by the 
robot wheel sensors. Now referring to fig. 7, the new position is calculated as an 
adjustment of the angle caused by the difference in the estimated and actual angle relation 
between two defined planes. The estimated angle refers to the extension direction of the 

25 defined plane that the robot moved along between FollowingStraightWall and 
endWallEncountered. In fig. 7, the solid-drawn line 13 relates to the actual extension 
direction of the defined plane, such as the wall or furniture side. The dotted line 14 relates 
the estimated extension direction of that plane, estimated based on information form the 
wheel sensors. Finally, the thinner solid-drawn line 15 relates to the correction of the 

30 estimated direction, where "K" is the correction and corresponds to Rdiff, the direction of 
Rdiff taken into consideratioa The adjusted direction may then be used as reference in 
the method algorithm and compared with the next estimated plane direction under the 
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It will be appreciated by those ordinary people skilled in the art that the present invention 
can be embodied in other specific forms without departing from the spirit or essential 
character thereof. The present disclosed embodiment is therefore considered in all respect 

5 to be illustrative and not restrictive. The appended claims rather than the foregoing 
description indicate the scope of the invention, and all changes that come within the 
meaning and range of equivalents thereof are intended to be embraced therein. The 
invention is not limited by the fact that the robot needs to have a room sensor system 
using JR or Ultrasonic signals in order to accomplish a wall following behaviour. Any 

10 kind of solutions, such as wheel rolling on the wall or any other solution close in fact for 
the person skilled in the art can be used. The only demand is that any selected solution can 
accomplish and detect a wall following behaviour, where walls correspond to any plane 
defined by the robot. 
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CLAIMS 

1 . Method for position determination of an automatic apparatus on wheels (1), at 

least one wheel comprising at least one wheel sensor that recognizes the rotation of said 
wheel (1), which apparatus also comprising at least one room sensor (2, 3a - 3e. 4a - 4d) 

5 detecting objects in the space surrounding the apparatus characterized in, 

that the position determination is accomplished at least by using at least one wheel sensor 
and estimate the substantial horizontal extension direction (14) of substantially vertical 
planes (13) on the objects (10 - 12), which planes (13) are defined by the apparatus, 
whereby the substantial, actual position of the apparatus is determined using at least one 

10 predetermined assumption on the relationship between the extension direction (15) of 
different planes (13). 

2. Method according to patent claim 1 characterized in that the motion direction, 

the motion velocity and the estimated position of the apparatus are estimated (8) at least 
15 using information from at least one wheel sensor. 

3. Method according to claim 2 characterized in that the estimation is also accomplished 
using stored information on wheel dimension and information on the distance between the 
wheels (1), which distance may be determined using a track gauge calculating method. 

20 

4. Method according to claim 3 characterized in that the wheel distance calculating 
method comprises a recurring calculation of the distance based of information on the 
wheel dimension and information about the position of objects in relation to the 
apparatus. 

25 

5. Method according to any of the preceding claims characterized in that the distance 
between the apparatus and an object is recognized using information from at least one 
room sensor (2, 3a - 3e, 4a - 4d). 



30 6. Method according to any of the preceding claims characterized in that at least one of 
the room sensors (2, 3a - 3e, 4a - 4d) uses ultrasonic signals in order to detect an object. 
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7. Method according to any of the preceding claims characterized in that at least one of 
the room sensors (2, 3a - 3e, 4a - 4d) uses mechanical detecting means in order to detect 
if the apparatus is in contact with an object 

5 8. Method according to any of the preceding claims characterized in that said extension 
directions (15) of the defined planes (13) are recognized using at least one of the room 
sensors (2, 3a - 3 e, 4a - 4d) and detecting if the motion direction (9) of the apparatus is 
substantially parallel with the extension direction (15) of at least one of said, defined 
planes (13). 

10 

9. Method according to claim 9 characterized in that when said parallel motion (9) is 
detected, the motion direction R0 of the apparatus is at first at a first moment TDO 
detected and thereafter, at later moments TD1 - TDn, the motion direction Rl - Rn is also 
detected. 

15 

10. Method according to claim 9 characterized in that when at least one of the room 
sensors (2, 3a - 3e, 4a - 4d) at a first moment TDend after TDO detects that the distance 
between the apparatus and the defined plane (13), which plane said apparatus moves 
substantially in parallel with, diverges from certain stored or by the apparatus established 

20 distance demands and/or at least one of the wheel sensors at a first moment TDend after 
TDO detects that the motion direction Rend of the apparatus diverges from certain stored 
or by the apparatus established direction demands, and/or if it is detected at a first moment 
TDend after TDO that a defined plane fulfils certain demands, a measuring of the moving 
distance of the apparatus counted from TDO to TDend is performed, said distance being 

25 calculated and stored. 

11. Method according to claim 10 characterized in that the direction demand 
corresponds to that the absolute value of the difference between Rend and R0 is larger 
than a certain first direction value and/or that the absolute value of the difference between 

30 Rend and the motion direction detected at a moment after TDO but before TDend is larger 
than a certain second direction value. 



WO 03/062937 



13 



PCT/SE03/00098 



13. Method according to any of the claims 10-12 characterized in that if said moving 
distance is larger than or equal to a certain stored or by the apparatus established distance 
value, at least the substantial motion direction (14) between TDO and TDend, based on 

5 information from at least one wheel sensor, is calculated and stored. 

14. Method according to claim 13 characterized in that the distance value is set to 
approximately 80 centimetres. 

10 15. Method according to any of the claims 13-14 characterized in that the said 
substantial motion direction is set as Ref Angle if it is the first substantial motion direction 
stored after a certain moment. 

16. Method according to claim 15 characterized in that the substantial motion direction 
15 (14) for at least one of said moving distances larger or equal to a certain stored or by the 

apparatus established value is compared with Ref Angle, whereby a difference in direction 
is calculated. 

17. Method according to claim 16 characterized in that a direction value Rdiff is 
20 calculated based on said difference in direction compensated by assumption values for 

differences in extension direction between two of the defined planes. 

18. Method according to claim 17 characterized in that the assumption values 
corresponds to at least one of the values 30° (DEG), 45° (DEG), 60° (DEG) or 90° 

25 (DEG). 

19. Method according to any of the claims 17-18 characterized in that if Rdiff is less 
than or equal to a certain stored or by the apparatus established direction value angleTh, 
the estimated motion direction (14) of the apparatus is corrected in correspondence to 

30 Rdiff. 
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20. Method according to claim 19 characterized in that angleTh is repeatedly adjusted 
based on the uncertainty established from the closest earlier correction, whereby angleTh 
has a limit value which is not allowed to be exceeded, said limit value being defined 
based on which relation in extension directions between different defined planes that the 

5 method is intended to handle. 

21 . Method according to any of the patent claims 19-20 characterized in that the value 
of correction in the estimated direction corresponds to Rdiff. 



10 



22. Use of a method according to any of the claims 1 
vacuum cleaner. 



-21 together with an automatic 
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